


f 


j! S nN 
iby 4 ‘ ts Me , 









Institutional Archive of the Naval Postgraduate School 


Calhoun: The NPS Institutional Archive 
DSpace Repository 


Theses and Dissertations 1. Thesis and Dissertation Collection, all items 


1991-09 


Sliding mode control of motions of towed ships. 


Samora, Arthur K. 


Monterey, California. Naval Postgraduate School 


http://ndl.handle.net/10945/26771 


Downloaded from NPS Archive: Calhoun 


| Calhoun is the Naval Postgraduate School's public access digital repository for 
D U DLEY research materials and institutional publications created by the NPS community. 
get Calhoun is named for Professor of Mathematics Guy K. Calhoun, NPS'‘s first 
KNOX appointed — and published — scholarly author. 





LIBRARY Dudley Knox Library / Naval Postgraduate School 
411 Dyer Road / 1 University Circle 


http://www.nps.edu/library Monterey, California USA 93943 


eo goer Pate a ad 
aVer attra sts 


ated oh one en 
Piss we ea eee 


pane 
. eat 


> date 


ia edotore 


——  S 


w~enre 


- 


= 


pene 


a orn ee 


wea e wee 
wane ¥* 


senate Om, 
ed acefe 


w—F 
tare wea 


wre 
wee 


camer ne ere Se’ 


oo ymca at 
or wrens? 


meet 
ad 


_” 


ore 
Pe beh 


ata were 
are subarea” 
nese 
yal oe 


ee ee 


epi ctor Ce” Cg 
WAREZ FIA SE 


ay. re 


face e* oat 


ene we oete 
“2 
Pe tinal 
awn te oe 
ew otarasmt=ss 


eames 


Cy he 
rate ae anne e, i 
wane 


_-° = 
“se 


Fe Dating 
* eronnawe 
ata wr eee 
ae ears 


. 


Pe 


etn toe 
Fare’ teres 


one 


came peer ew 


eiaranr 


Merle en ntes 
. aoato 
a 


wwe tate. 


ePodet ates sone arse 
ae By Cs 
rete ee ent S 


pas 
ss vor oe 
Pa 


ve 
aeonreer aon at 


are Oe 
ane © 


rest 


eee tation 
fai atars 


Pa iaree., «arp 
td 


tre Bete 


yrad?, 


Orga eG OL NOY 


TL ae 
paeuts! ~wee 
perry 


seet SEK Rrra” 
utat 
sntietyrare 
of> 
aud oft 
aseoed ENOTES 
Me ipee tad 
ate teeny Ms tae 
quem actornse VF 
Cec ee CLIT 
m—e we © 
Cry > peated 
a mee tas 
ect, Oe f* 


Pt eta cee 9 Prat . 
ate pets Pent of 
oparavac at 
apes 
aye! 
b heed 


vag ae er en 
et a 


~ mt nesta ® 
Bie ster 
wi atto? gavel 
nen oore 
nol ~ 
« stp rr Fee 
a enta eon ee 


Tt aad 
Ft Swat rw 


- 
sa 


ae oe were © 


wat ane of ot 


wee 


ewe a warte® 


Pet 
2 sheer” 


aie 0 Chas ehe 
vee of teat? 
owe 

a owas 
= oe@orr 
gee 
swthe wen @ 


. 
wae 
Pee es 

eee eh Ota 


ty afer 


OaPers soe 2 © 


ce aia eee Ew 
ates un 
oon 


~e eet 


onto 
orm 7eeNe 
« toe Fhe 


oer we . 
sea mare we = 
ome eo * 


~ 
Pee UL Sakae 


ga ne see ee 


et 
ty anes 


+ Ceshlon 
Cea td 


Fit aes ee 
af teeth ee 
Pape oeaty fe 


Fan 


taanre 
pitek abs ee 
f aks ger Ese hee 


Cah wan POMS * 


~ 
ec sees « ogadnte 
Lied 


Fatih peo A492 
See aS Saint Lanael 
a te 
rr 
+f 
aed af wah Qe 
ne ae meee aeeee 
cou 


72 ed TET 
Pe erns ot 

ape 0 fete 2 et OOF 
8 eds ON 


In 


striee 
wees t 


Par) 


apag =f? 
ane 


reer 
agradat Sarre WM 


ceedug af SS? 


er ae al ets 


eT On dy dated 
cone’ 


Ke wre te nd ot 


.adh Gee TE 
eer 


.'oe oor 
ear mse Nt ange 
wt ieee itt hae 

seu sy ee 


spewed Freee 


aw tre 
e Meet loete a 
i ” 


aut 
fe ome ee gedores SRgeh 


greet eed get 


ma an eet heer Dy 
~~ a ebenanen! ous 
or geet 
1s + fae 
Fy tee ah sh ee ey 
ratm + Pe 


eS ae hates 
wong a8 


cig tah 


POT ad tel fd Ses 
a TiAl ho 


o dee? Fae ee 
*gat tre = eons 
cima dt 


+ setats tre 


see ws. 
sete Lb ne 
OP Ys a 


tas 


Me wren ee 2 WS 


Bilao 8 
wehesah mene 


are tyes ase e 
Poot, we ST! 
Ptr a ae died 


wa fur ef A RS 
ay regneetid evqert 2" 
= oth ariteeates wt 
ado A Oy EOE Ts 
a) vase UMone avery? 
on yew 
te th Pheee OF 


Pas 
ad he WOO 


At re Vw 
eereure 


pgm ree ase Fs 
oan ser hi 


setae 
Pot Taree 


ae 4 
Bagh shaves 


pe neidan oF 
we 


eererynssee et hh 


oAha we a PRsh ete 
» at eat Geter et geste aWe 
napead Efe wanes FP 
* por w 


ee Swims 
(aden oma Ael awns me 


yn 
AMT 
oe 8 f 
af aguwea 


fas Yrereth OF 
ws The amet F* w owe 
sat . ' 


Pee ee 
aot cd 


ata 
a as a 


ee tee poet = egdbs 


yen” * 
od ae agrees Ormweee 
ey eh 8 ere Oe 
2 odd bene FRE 
ae ete 
oe tht 


we? 
dah oSe see . 


a 
ageenaes af sernece 


etek * * 


mo 1 el Coad 
whore ow Oe he 


Low 


seen cere? 


ee eT hel ~eeeet 
foe enre cer 


eatarete 
ae 


* 


wet re 
sae Onset Oo 
oe apes rea 8d oF 


ane BTS Ot 
ae 
se eee 


Jwwe im on rep eter” 


co wagent test © 


ce aor IS 
atta ee 
me weer 


a susfee 
. tag Geer 


yee tems 


wie 
. . 


wets 


Ciel 


wate eos ae 


oe 


Pr 
win = 
ame wtbete suee S¥° 
ate 7 4 rte 
go OF lal ANP 
-" 


ne 


i) Pal * 
> aire et evans 
ee 


govt @ 
) weaned ote FA bad 
at fte ee we sreted tare! 


vases «tahun 
Sethe? 


fag 0% 
auewete ah 
Pre idee 
Rene tyes Od 
Ter ete 
preag seer we 
«w* 


eupedtene tte 
ad 
veers. 


eae 
wat see 


a4 ~ 
¥'a* 


hate 
We het 


> 
, toe 8 


pee eeete 


sone erat e* 
ote 


ospeewetet MMe 


seh 


erarasa acer" 
. PP oa 


wr cspuentse 
ete Pre Eee ae Seve 


yee 
ceetaee teeae Gre hd 


wee 
Le state ose Ores 
eretd 
eon re & & 
sn ter eke Y 
- ree greene? + 


Zo wate oes ee 
sgecelate ome 


* 


eS Mee 
omar 


sor Ste 
oe tA 


sacs Sete 
eerste 
7 


wun 
et ue 
P sreurse ~ 


PO A te 


pred greet eo 
eueurye ae 


ate 2 4 ope 
7” 


- 
apogee af 
Perr 


«got 2° = 
2 we ete 
= OF 


wer - 


er ae he 


a Tape ve 


a 6 wore @ 
ve 


ie 2. en 


Se. yer ead Ca ee? TE 


Sa ay ta hee ed”? Pee i ebed 
un chee pig ben amakanns a phadactats™ 
babe rad Me whet aap gia beles* aout mine's. 

ata" Rote vert Baa ae 


eRa tarts Fame 
rae 


Sata 


ere tates? 
pape cue se, *4 


aude Detaae 
Fed del 
* 
cy et he hae Pr ded 
Pach ache wes Ped OOF RA 


Pm 
Ag begets 


tae 
4 ren he. FOES 
Fo vy mers ab 


Pitetts 
chee ot ere ote 
rete erage” Ve 
eat? 
OPT Ee ied lal 
aghend ete Rysets 
Pe te rath rete ws 
1 


“agg oe Tae 
ati tnd 
sb ele 


new’ oe 
one We 
Narace goons ree 


wore ote 
ST hae 


Pr hdl 
Fe Pare ee OPS 


avatar tote * 
ahs © 
Brak 
ne * 


are 
+ Maer 
a 


ups awe 
vette We te Pa = 
A eed 


Me ad 
wiet 


so harets Pe? 
aan te tee 


ed 
row? eas Pas ow” = 
emmtatact we hue 

aey-om 2 ate 


we peters 
*etee= +ate 


Pe Lind 
Pry ed 
Pe Radel 


wane od! 
gn ESD 
re 


onan eeerie 
sate eee 
“w, 
PIT bel 


aor > Ut 


voregtate® * tele ote awe 


5 hel 
So ape 


‘esa etiacerd * 
- 


age tore apy ae 
ery Ppatecs ah yy 
egret ametate Pus & 
apes keene Oe" ¢ 
eat 
oe 


Lees qian Boe 
sgvaretn #8 “ewe & 
a9 sete 


ng neta Keer 
eats whee Phere 
Se te we rater he F 
Bete > 
ee 


owe ee ewe fe 
tenes 


anes 
Fen ee 
we at ear ee  * 
Pog i wee ee auekctn ew ee 
1s Ste owen owe 
~ awe ae 
aw e™ 


- : “eae Bet 
ee yemts wee whee Phot ded 
one 


wvhaes v 
he Re 
Mae ee ded 


ow whe 
«oye en 


sonra ture 


mera H+ 


wr 
saeewese 
ow = 8 














NAVAL POSTGRADUATE SCHOOL 
Monterey, California 





THESIS 


SLIDING MODE CONTROL OF MOTIONS 
OF TOWED SHIPS 


by 
Arthur K. Samora 


SEPTEMBER 1991 


Thesis Advisor: Fotis Papoulias 





Approved for public release: Distribution is unlimited 





Unclassified 


ee a 


SECURITY CLASSIFICATION OF THIS PAGE 


Form Approved 
REPORT DOCUMENTATION PAGE 
1a. REPORT SECURITY CLASSIFICATION ib. RESTRICTIVE MARKINGS 
Unclassified 


_ | 2a. SECURITY CLASSIFICATION AUTHORITY 3. DISTRIBUTION/AVAILABILITY OF REPORT 


Approved for public release: Distribution is 
2b. DECLASSIFICATION/DOWNGRADING SCHEDULE 






unlimited 
4. PERFORMING ORGANIZATION REPORT NUMBER(S) 5. MONITORING ORGANIZATION REPORT NUMBER(S) 
6a. NAME OF PERFORMING ORGANIZATION 6). OFFICE SYMBOL 7a. NAME OF MONITORING ORGANIZATION 


(If applicable) 


Naval Postgraduate School ME Naval Postgraduate School 


6c. ADDRESS (City, State and ZIP Code) 7b. ADDRESS (City, State, and ZIP Code) 


Monterey, CA 93943-5000 Monterey, CA 93943-5000 





8a. NAME OF FUNDING/SPONSORING 
ORGANIZATION 


8b. OFFICE SYMBOL 9. PROCUREMENT INSTRUMENT IDENTIFICATION NUMBER 
(if applicable) 





8c. ADDRESS (City, State, and ZIP Code; 10. SOURCE OF FUNDING NUMBER 


: PROGRAM WORK UNIT 
ELEMENT NO. O ACCESSION NO. 





- 111. TITLE (include Secunty Classificauon; 


SLIDING MODE CONTROL OF MOTIONS OF TOWED SHIPS 


12. PERSONAL AUTHORS 


ARTHUR K. SAMORA 


13a. TYPE OF REPORT 136. TIME COVERED 14, DATE OF REPORT (Year, Month, Day) 15. PAGE COUNT 
Master's Thesis Pie SE SEPTEMBER 1991 63 


16. SUPPLEMENTARY NOTATION 


The views expressed are those of the author and do not reflect the official policy or position of the 
Department of Defense or the U.S. Government 


17. COSAT! CODES | 18. SUBJECT TERMS (Contnue on reverse if necessary and identify by block numbers) 
FIELD alee towing, control, stability, automatic control system 
 _ aa 


19. ABSTRACT (Connnue on reverse if necessary and identity by block numbers) ! 

A control system based on sliding mode control and the linear quadratic regulator is designed to | 
stabilize the straight line motions of towed vessels. The control technique is through athwartship movement 
of the towline attachment point on the towed vessel. Control design is based on the linearized sway and yaw 
equations of motion. Numerical simulations for both the linearized and the nonlinear system are performed 
and demonstrate the added robustness of the control technique employed. 






20. DISTRIBUTION/ AVAILABILITY OF ABSTRACT Pi. ABSTR nN CLASSIFICATION 
XX UNCLASSIFIED/UNLIMITE D __ SAME AS RPT __ DTIC USERS unciassifl 
22a. NAME OF RESPONSIBLE INDIVIDUAL D2b. TELEPHONE (Include Area Code) | 22c. OFFICE SYMBOL 
Fotis Papoulias (408) 646-3381 ME/Pa 
DD Form 1473, JUN 86 Previous editions are obsolete. SECURITY CLASSIFICATION OF THIS PAGE 
S/N 0102-LF-014-6603 nclassill 
ab 


7959153 


Approved for public release: Distribution is unlimited 
Sliding Mode Control of Motions of Towed Ships 
by 
Arthur K. Samora 
Lieutenant, United States Navy 
B.S., U.S. Naval Academy, 1984 


Submitted in partial fulfillment of the 
requirements for the degree of 


MASTER OF SCIENCE 
IN MECHANICAL ENGINEERING 


from the 
NAVAL POSTGRADUATE SCHOOL 


SEPTEMBER 1991 


ABSTRACT 
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I. INTRODUCTION 


The horizontal plane stability of towed vessels is a very important field. If 
the motion of a vessel under tow is unstable, a very dangerous situation exists; 
the motion of a several thousand ton vessel could endanger the ship towing it 
[Refs. 1, 2, 3]. A method needs to be developed not only to ensure the stability of 
the towed vessel’s motion, but to control it [Refs. 4, 5]. If the motion of the towed 
vessel can be controlled, the next step is to optimize its control, both for safety 
and fuel considerations. Usually the only means of control of a vessel under tow 
is through the towline. Under these conditions, stability of the vessel is marginal; 
in some cases, the vessel is actually unstable. 

This thesis will develop the equations of motion for a vessel in tow. It will 
also state and describe the unique forces associated with a vessel being towed. 


Finally, it will describe how state-space theory is being applied to control the 


towed vessel’s motion through the movement of the attachment point of the 
towline along the beam. 


A control system based on sliding mode control and the linear quadratic 
regulator for the linearized equations of motion will be presented, with results in 
non-dimensional form. The same control system for the non-linearized equations 
of motion will also be presented, along with the results. Comparison of results for 


the linearized and non-linearized equations of motion will help determine the 


robustness of the system. Matrix, will be used to calculate the required gains for 


the system, and the simulation will be done using a Fortran program. 


Il. EQUATIONS OF MOTION 


The two equations of motion will be developed using a body-fixed frame of 
reference. The origin of this reference frame is at the center of gravity of the 


towed vessel. In general, the vessel has six degrees of freedom: 


I. surge along the x,-axis 
Pa roll about the x,-axis 
3. sway along the y,-axis 


4. _ pitching about the y,-axis 
5. heave along the z,-axis 


6. yaw about the z,-axis 


This thesis will only deal with motion in the horizontal plane. Also, a constant 


surge velocity along the x,-axis will be assumed. Other assumptions include: 


1. no towed vessel/towing vessel interaction 
Ue massless, inextensible towline 
3. no wind, wave, or current disturbances 


4. the body is symmetric 


Since motion is confined to the horizontal plane, the applicable equations are the 
sway and yaw equations. These equations are standard Principles of Naval 


Architecture, or PNA, equations. They are as follows: 


Sway: 
mlo+ur+wp+x (pqg+r)-y (p? +r?) +z (qr-p)] 
ESTOS Ady Ye , 84" -P wk 
=(W - B) cos cosd + Y, 
Yaw: 
T¢+(1 -1), =p 9 eae 
m[x (o+ur+w)-y (u-or+wq)] (1b) 


= (x w - xB) cos® cosh + (y,W - y,B ) sin® +N, 


If we make the above assumptions in terms of the variables in the equations: 


1% No vertical motion; w=0 
2. W=B 
2S: Small angle motion (linearized simulation only) 


4. No pitch rate; also negligible roll; 6=0, 6=0, o=0 
> Forward speed equals nominal speed; u=U 


6. Center of Buoyancy=Center of gravity; x,, Y,=Xa, Ya 


Then the sway and yaw equations become: 
m(o+ur+x7)=Y, (2a) 


7 +mx, (O+ur)= N, (2b) 


The hydrostatic forces on the right hand side of the equations are then expanded 


in a standard Taylor series: 


ie = ee aA Me = Y,0 a YF = Cos (3a) 
N,=Nv+Nr+N,o+Ni7+N,., (3b) 
oY 
h = ea : 
where = ¥, = —— Pee CEG 


Note that the rudder terms, N; and Y; have been omitted, as the towed vessel’s 
rudder is amidships; there is no applied force due to the rudder. The only applied 
force is due to the towline. Substituting (3a) into (2a) and (3b) into (2b) and 
rearranging the terms yields: 


Sway: 
Grate) C70) ie o ate nin) + Y (4a) 


towline 


(L-N)¥-NO=N0+Nr+N,,.,, (4b) 


which can then be rearranged into working form as 


Y,0+(Y,-m)o+ CY, - mu) + YW = Y tine (5a) 


Nv . N,v " NW sf ( N, . : W - esi (Sb) 
where r=y, z=. All that remains is to describe the towline forces in greater 


detail. 


A. TOWLINE FORCE 

In Figure 1, P is the attachment point of the tow. x, and y, denote the 
distance from the towed vessel's center of gravity, again using the standard PNA 
body-fixed coordinate system. From the diagram, we can see that the horizontal 


force associated with the towline in the sway direction is: 
Tsin(y+w) 
The moment causing the vessel to yaw is: 
-Tx, (sin(y+w)) -Ty, cos (y+) 


Assuming y and y are small angles: 


Ye 


T Sd 


Sun C= ya 


an ] x» 
=V a 


Path re) 


y 
i Os 
} ea i 
Co y p Ne Y 
ee J a 
X SS 
p ~Yp 


Figure 1. Towed Vessel Coordinate Description. 


Also, 


y =v+usiny =v +uy 


V=Yy UY; 0 =¥ -uUY 


Finally, substituting for v, in equations (Sa) and (5b) and rearranging terms: 


Sway: 
(Y if yy-l Varn Y 
6 7 Ya, ie gv oe 
(6a) 
-[Yu+T eee yoo 
g ais LL 
Yaw: 
: aula “-(N 
Ng + Ne ee u-N OW 
x (6b) 


a ele i ate lw 
fe 
ee 


These two equations are motion describe the towed vessel’s motion. Note that the 
coordinate y describes the lateral distance from the towing path; y, describes the 
distance of the towline attachment point from the centerline of the towing vessel. 


It is for y, that the control law is being developed. 


B. ARRANGEMENT INTO STATE-SPACE 


Let X,=y, X=, X,=y, x,=, then, substituting into equations (6a) and 6b) 


te) ae 


(7a) 
ad Y jE *P Y u 
eel ut Meer Xe ee a, 
N Xx, oN elles, 
is +[Nu+T 1+]? ] (7b) 
= pees 4 + TX, i 
x,-Nx,+(Nu-N.)x ey +7 
2 ve 0 yw’ 4 L oe Uh 
From the definition of the state variables, it can be seen that 
X, =X, (8a) 
and 
X, =X, (8b) 


These comprise the first two of four state equations. The second two state 
equations must come from equations (7a) and (7b) above. Note that these 
equations are coupled in x, and x,. Algebraic elimination yields the final two 
equations of motion. Multiplying equation (7a) by (N,-I,) and equation (7b) 


by (-Y,) yields an equation for x,. 


TON, ~ LOY) oe enemies 


fe 
Spl) gl 


“ly af salty -] ) 
D L y z 
5 (8c) 
-y,|s + Tx [ eae Ih: 
y Dv Pp ie 


+(N,Y,-Y,(N,-1) 1x, 


Cae - YOON, -1) =e les 


(N.-I) x 
7] Mood ah 5h 
ik Y L P 


Similarly, multiplying equation (7a) by (-N,) and equation (7b) by ( Y, -m) 


and adding yields an equation for <,. 


10 


[(N,-1,)(¥,-m)-N,y 1%, 


a 
sisal eed) Ned i 


+{(Y. -my| = [ =| 
S| OT 
x (8d) 
Ne arco |i a 
re] re) L 


aN INOS oi es 


aie era aii NN y) x, 


Tey biel Ni 
i ee aa a 


Equations (8a), (8b), (8c) and (8d) can also be expressed in state-space matrix form 


2} 1 2 (9) 


Where, 
D=(N,-1,) (Y,-m) -NW,Y, 
eos tN = 7.) - x Y | 
3 a y z PW 


ape Dfywue [2 «3 |Jeyrte -¥4|oe ts, [3 + 3 }p 


11 


a,,=D™- [N,Y,- ¥, CN@eee ae 


a,,=D"[ (Yju-¥,) (N= 2) een 


gE = [ x. (¥,-m) -N,] 


‘ ~ 
a,,=D--{ (2a le) aa 1, [1 a= |e [zeer[a oF 


a,,=D"([N,Y,=N, Gy =e 


a,,> D> | NY NY, ce 


(N,-I,) 


px oer] Meet) y fs « % || 
L v r 


WZ 


II. CONTROL SYSTEM DESIGN 


A. SYSTEM AUGMENTATION 

Equation (9) defines the state-space form of the equations of motion. One 
more state must be defined and added to this equation; that of the ordered, or 
commanded, y,. This variable shall be called y,.. The usual response of y, with 


respect to time should look like a first order system, as in Figure 2: 





Figure 2. y, Response with Respect to Time. 
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The equation governing this response is as follows: 


TY, "4p ~ si 


— 


OT > = 


where T, is the non-dimensional time constant for the towline attachment point 
motion control system. If y,. is now considered the input to the system, and y, 


is considered a state variable, the matrix equation becomes: 


—] 1 
y | | 290 08 oe ee eee 
ei ie P T 
m we osu tC . 
0 
26 = 6% ep y (10) 
0 0 = 4 | Qimeeaes 
-_ b, ay, a, a, ay, *3 0 
x4 bo oa.a.a.a.|*a 0 


Where a3), A397, 33, Ay, Aq, Ago, 43, Ay, Dz and by are as previously defined. In a 
sense, the actual distance of the towline attachment point y, is treated as an extra 
state to the system. The control system will be designed based on this augmented 
system of equations. The control system will be designed based on two principles 


of state-space theory; Linear Quadratic Regulator, and Sliding Mode Control. 


B. LINEAR QUADRATIC REGULATOR 
The linear quadratic regulator function arose from efforts to find an 
optimum means of control [Ref. 6]. Normally, a gain matrix for a particular 


control system is calculated to achieve specific closed-loop pole locations. With 
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the linear quadratic regulator, or LOR, a specific performance criterion J (or "cost 
function") is defined, with the only stipulations on the poles being that they be 


negative, or stable. This criterion J is defined as: 


J= fx" (1) Q(t) x(t) +u! (t) R(t) u(t) Jat 
The matrices Q and R are weighting matrices. The matrix Q is a state 
weighting matrix, and R is a control weighting matrix. The gains for a control 
system can be calculated based on the defined matrices Q and R. For instance, if 
the elements of the matrix Q are small relative to R, the system will tolerate large 
errors in the final state with very little control effort. Conversely, if Q is large 
relative to R, very small errors in the state X will result, but with considerable 


control effort. 


C. SLIDING MODE CONTROL 

The second aspect of state-space theory to be used in controlling the towed 
vessel is that of sliding mode control. Since the control law is based on a 
linearized set of equations of motion, a lot of uncertainty in the response exists. 
Also, some of the parameters may vary. A good example for the towed vessel 
system is the towline tension T, which will certainly vary with time. A control 
law needs to be developed that will take into account both the uncertainties in the 
parameters, and any dynamics that have either not been modeled, or that have 
been linearized. A sliding mode control law can ensure both stability and 


robustness of the system, with the emphasis on robustness. The LOR gains will 


ils. 


ensure stability of the system. Sliding mode control is ideally suited to a system 
where the response oscillates between set values, such as the motion of a towed 
vessel; it uses a high speed "toggling" control law to drive the system onto a 
desired "sliding plane." 


Sliding mode control takes the standard state-space system 


x=[A]x+{b]u (12) 
and defines a sliding plane 
O(¢) =S x +S )X5 Yoo (13) 
and the coefficient s, is arbitrary. Equation (13 ) can be written as 


s'x=0 


where 


. af = 
gl = [SiSe/Suicasl 


Next, define the Lyapunov function 
1 2 
V(x) = 55 Lee) 


stability is guaranteed, provided V(x) is a negative definite function. Another 


way to express this is 


V(x) = 0(x) 6(x) = -1? (x) (14) 
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therefore, 
8 = -n’ sign® (15) 
Since 
6(x) =s'(x), 0(x) =s'(%) =s (Ax +bu) 


so, substituting for @ in Equation (15): 


s'(Ax + bu) = -1’ sign(@) 
and solving for u: 
u=-(s'b)'s"Ax -n’(s'b)" sign(@) (16) 
Equation (16) is a sliding mode control law for a generic system. 
D. THE CONTROL LAW 
All that remains is to define a control law for the augmented equations of 


motion for the towed vessel. The control law is defined using sliding mode 


control and linear quadratic regulator principles. Take the augmented system: 
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1 
J} |-a 0 0 0 0 Hy, a 
“ 0 0 “ > 

z (17) 
xX, i 0 0 ] 2: = 0 Wine 
xe b, as, as, a5; Aa, = 0 
* b, ay ay G43 ay, *4 0 

a A, 


and split the augmented matrix A into Aj,, Aj, Aj, and A, as shown. Also split 


the state vector into 
T= 
Y, = V7 Ve Breer. | 
Rewrite equation (17) as 


y, Say, + AY, + bu 
y, a AY, A,Y, Bs bu 
The original augmented state vector x now equals (yj, y2). 


Next, define the sliding plane for the towed vessel as 


Q(x) =O(y,,y,) =y, +s'y, =0 (18) 


and 


6 = -1" sign(@) = y, = s"y, (19) 
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but 
Yo Cena, + AY, 
so, substituting for y. and y, is equation (19): 


Ay, + ,u +s‘ (ALY, + Ayy,) = -11° sign (8) 


solving for u: 


=) 


; [(A,, 78° A,, )y, +8‘ Apy,] - =n? sign (@) (20) 


1 1 


u= 


This is the system control law for the towed vessel. 
The gains [s] for the sliding mode control law from minimization of the 


linear quadratic regulator cost function J. Recall that 


J= (Lx) (QU Ex] + (a) (RI [uD dt (21) 

in Equation (21) the state weighting matrix Q is as follows: 

0 0 00 

0 q,, 0 0 

‘10 0 00 

0 0 0 04 
where q,,. represents an error in radians from the path of the towing vessel. We 
are choosing to weigh the state variable x, = y. The control weighting matrix R 


will be defined by 


ee, 


R=(a)~ 
where a, the maximum non-dimensional distance y, will be weighted. With Q 


and R defined, the cost matrix function becomes: 


J =min [4p %3 + Ru* )dt (22) 


Or 


J =min [Unw + Ry?) dt (23) 
The smaller the value for R is, the smaller the control effort required, but a larger 
State error in q,, will be have to be accepted as a trade-off. Conversely, the larger 
the value for R is the more control required, with very little state error in q,». 
The resulting gains are then placed into the control law for the augmented 


system of equations, Equation (20), and the response of the system is obtained. 
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IV. RESULTS 


A. MATRIXX AND FORTRAN IMPLEMENTATION 

MatrixX is an outstanding tool for understanding the response of a control 
system. A Fortran program was written to use with MatrixX. Since the coefficients 
of the [A] and [B] matrices of the state-space equation are constant with time, 
they can be put directly into the MatrixX software, and the resulting Linear 
Quadratic Regulator gains are easily calculated. Without the use of Matrixx, 
solving the linear quadratic integral is a very difficult problem in numerical 
analysis. The actual simulation of the system response was accomplished with a 
Fortran program on the VAX computer. The LOR gains obtained from Matrixx 
are put into a data file, along with the non-dimensional parameters of T,, LL, X,, 
T, and the initial conditions of Y, y, and the maximum distance pecan travel 
athwartships. The simulation then reads this data file, computes the sliding mode 
control and plots the response of the parameters Y, ne y, and Lom with respect to 


time. 


B. INITIAL CONDITIONS AND CONSTANT PARAMETERS 
The results are presented graphically, and are in non-dimensional form, with 
the exception of the yaw angle y, which is in degrees. The non-dimensionalization 


is standard Principles of Naval Architecture: the relationships describing the 
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nondimensional parameters are included in the Appendix. Two vessels were 


studied: 


iL. 528 foot mariner 


De 1066.3 foot tanker 


A summary of the hull particulars and hydrodynamic derivatives for both these 
vessels in also included in the Appendix. Four knots was used as the nominal 
forward velocity. The mariner is stable at four knots; the tanker is unstable. The 
towline tension for both vessels is taken from resistance curves at four knots, and 
then non-dimensionalized; the value used is 0.001 Xp the longitudinal distance 
from the towed vessel center of gravity to the towline attachment point, is 
assumed to be constant. A value of 0.5 is used. The time required for Y, to 
"match" Y,. as in Figure 2, T, is set as 0.5. The maximum non-dimensional 
distance Y, can travel from port to starboard extremes is taken to be 0.1; therefore 
the maximum distance from an extreme to centerline is 0.05. The initial conditions 
for each data run are Y=0.5, y=0, and Y,=0.05 as in Figure 3. Also, the weighting 
matrices were set at q,=5° (or .087 radians) for Q, the state error weighting 
matrix, and a=0.015 for R, the control effect weighting for Y,.. Four plots were 
generated for each simulation. The y-distance from the path (Y), the towline 
attachment point lateral offset OOY the towline attachment point offset command 
(Y,.) and the yaw angle (y) are all plotted vs nondimensional time. Variance of 


parameters of interest are shown on subsequent runs. 


Center 


of 
Gravity 
Center | 
of y LL Towing 
Gravity, | Vessel 





Figure 3. Initial Conditions. 
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1. Figures 4 and 5: Standard Mariner and Tanker 

Figure 4 shows the response of the mariner with the "standard" 
parameters and initial conditions stated above; Figure 5 shows the "standard" 
tanker. Overshoot in Y and y exists for both cases, although it is higher in the 
mariner. The Y,. graph shows that significantly more effort is required to control 
the tanker, and the oscillation in Y, is much greater than for the mariner. This 
makes sense, as the tanker is inherently more unstable. Both vessels converge to 
a straightline path in approximately 60 non-dimensional seconds. As the tanker 
is more unstable, it will be used to demonstrate all other variations in parameters. 
Henceforth all references to "normal" or "standard" tanker response will be to the 


response shown in Figure 5. 
2. Figure 6: Tanker with Y, yY Not Observable 
Figure 6 shows the vessel response if the state variables Y and Y are not 


observable and are not used in the control law. Both Y and Y converge but the 
time required is significant; over 100 seconds. In this case there is no overshoot 
in Y, but considerable overshoot in y. y, Y,,, and Y, all oscillate considerably; but 
in the end, the system does converge. 
3. Figures 7, 8: Observable Tanker, Variance of 6(x) 
Recall from Equation (13) that the sliding plane Q(x) is in part arbitrarily 
defined, as the gain n’ is chosen by the designer. For the standard runs, n’ was 


set to be 1.0. Figure 7 shows the tanker response if 1’ in (x) is set to 0.5, with all 
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Figure 4. Mariner Response with Standard Parameters. 
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Figure 5. Tanker Response with Standard Parameters. 
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Figure 6. Tanker with Y, Y Not Observable. 
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state variables observable. The system still converges in adequate time; the 
parameters Y, Y,, and Y, behave as in the standard tanker. There is 
approximately twice as much overshoot in y, however. In Figure 8, 1’ is set to 
2.0; this brought the overshoot in y down to the level of the standard observable 


tanker, without altering the favorable response of the other three parameters. 


4, Figures 9, 10, 11: Non-Observable Tanker, Variance of 0(x) 
The state variables Y and Y were assumed to be not observable in 


Figures 9 and 10. In Figure 9, 1’ was set to 0.5, with disastrous results. The towed 
vessel becomes unstable. All four parameters diverge with time. In Figure 10, 
however, 1’ in 6(x) is set to 2.0, and the system response stabilizes. The overshoot 
in Y is approximately as the same as the standard tanker, but the overshoot in Y, 
and Y,,. is twice that of the normal tanker. The settling time in Y is double that 
of the normal tanker, but the settling time in, bg: and 1, is cut to forty seconds. 
Obviously there is a value between 1? = 0.5 and 1 = 1.0 in @(x) where the 
response turns unstable for the non-observable case. In subsequent simulations, 


* is set to be 2.0. Figure 11 summarizes the response of Y and Y, for the 


n 
observable and non-observable, with n’? = 2. The top two graphs are for the 


observable case, and the bottom two describe the non-observable case. 


5. Figure 13: Variance of the Sliding Plane Switching 
Since sliding mode is a high-speed switching, or toggling method or 


control, the speed at which the switching is to be accomplished must be defined. 
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Figure 7. Observable Tanker, 7’=0.5. 
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Figure 8. Observable Tankers, n*=2.0. 
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Figure 9. Non-Observable Tanker, 77=0.5. 
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Figure 10. Non-Observable Tanker, 17=2.0. 
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Figure 11. Observable, Non-Observable Comparison 
of Y, Y, for *=2.0. 
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100 


This switching speed can be defined in terms of an angle. Note in Figure 12 that 
as the angle @ approaches 90 degrees, the system is being asked to change 
instantaneously. Another way of saying this is that the system is ordering the 
towline attachment point to move instantaneously from port to starboard. o=90 
degrees is impossible; the designer has to allow the system time to react. 
Figure 13 shows the observable and non-observable tanker response of 
Y, Y, for 6=30, 6=45, and o=60. For the observable case, overshoot, the amount of 
oscillation, and settling time increase as @ increases. For the non-observable 
tanker, the response destabilizes between 6=45 and o=60. Clearly there is a limit 


to the switching speed of the system. 6=45 was used for the standard tanker. 


6. Figure 14: Variance of LOR Weighting 

Figure 14 demonstrates the effect of varying the control effort in the 
linear quadratic regulator. As @ is increased from 0.005 to 0.035, more effort is 
used to control the towed vessel motion. In Figure 14, Y and Y, responses are 
plotted for four different values of a. In all four graphs, the tanker is observable. 
Note that as a increases, the overshoot in Ng decreases, and the settling time 
remains about the same as for the standard tanker. This makes sense; more effort 
is being expended to control Y, through Y,,.. The response of Y remains essentially 


unchanged. 
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Figure 12. The Sliding Plane. 
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7. Figure 15: Observable Tanker, Variance of T, 
Figure 15 demonstrates the effect of varying the time allotted for Y, to 
match Y,. for the standard tanker. The T, used for the standard case was 0.5. 
Varying T, does not significantly affect the behavior unless the change is in order 
of magnitude. This result has favorable implications; if changing T, doesn’t 
radically affect the towed vessel response, a smaller motor can be used to drive 


the device moving the towline attachment point, Y,. 


8. Figure 16: Variance of Towline Length 
Figure 16 illustrates how changing the towline length will change the 
response of the tanker, both in the observable and non-observable case. For this 
simulation, the non-dimensional towline length, LL, was lengthened and 
shortened by twenty percent. If the towline is shortened, the overshoot and 
oscillation in Y and Y, will increase for both observable and non-observable cases; 


the reverse is true is the towline is lengthened. Settling time will remain the same. 


9. Figure 17: Variance of Towline Tension 
Figure 17 shows how changing the non-dimensional towline tension 
will change tanker response. If the tension in decreased, the overshoot remains 
about the same; oscillation and settling time in Y and Me increase for both the 
observable and non-observable cases. The reverse is true as the tension is 
increased. A 20 percent change in towline does not cause a radical change in 


system response. 
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10. Non-Linear (Large Angle) Motion 
Recall from page 6 that the horizontal towline force associated in the 


Sway direction is 


Tsin(y+y) 


and the moment due to the towline causing the vessel to yaw is: 


-Tx (sin(y+w)) -Ty cos(y+w) 
Previously the assumption was made that the range of motion for y and y was 
less than 30 degrees. This simulation lifts this restriction; the sine and cosine 
terms from the towline tension term are left in when running the simulation. 
Figure 18 plots the standard tanker response for both linear and non-linear 
tensions. Note that the tanker response remains stable; the sliding mode control 
law is robust enough to handle non-linearities in the towline tensions. The non- 


linear Fortran simulation program is included in the Appendix. 
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Figure 18. Non-Linear, Linear Tankers With Standard Parameters. 


43 


150 


V. CONCLUSIONS AND RECOMMENDATIONS 


A. CONCLUSIONS 

This thesis explored the possibility of athwartships movement of the towline 
attachment point as a means of improving the stability of towed vessels. Newell 
demonstrated that use of a full order observer will work only when the towed 
vessel trajectory is close to that of the towing vessel [Ref. 5]. Sliding mode control, 
in conjunction with the Linear Quadratic Regulator cost function, provides a 
much more robust method of controlling the towed vessel motion. The sliding 
mode control law can ensure stability of the system, even if not all the state 
variables can be observed. The only restrictions for the numerical applications 
considered in this work are that a toggling speed such that 6 is less than an angle 
between 45 and 60 degrees is used, and that the toggling gain 7’ is greater than 
a number between 0.5 and 1.0. The LOR function allows the designer to choose 
where his emphasis is placed. By choosing whether to place the emphasis on the 
control effort, the designer can minimize the size of the motor required to drive 
the mechanical apparatus used to move the towline attachment point. If the 
designer wants to minimize steady state error, he can change the LOR function 
to reflect that emphasis. The LOR function can also be used to minimize specific 
state variables, such as in the case studied, where y was chosen to be minimized. 


It should be emphasized that a "worst-case" scenario was used to demonstrate the 


robustness of the system; a large, unwieldy tanker was used, and two of the four 
state variables were declared "not observable." Even in the worst case the sliding 
mode control law performed adequately. Towline tension and length were 
increased and decreased by 20 percent, and the system remained stable. The small 
angle motion assumption was dropped, and yet the system continued to perform 


satisfactorily. 


B. RECOMMENDATIONS 

The sliding mode control law should be robust enough to cover most of the 
unmodeled dynamics and non-linearities, but two of the assumptions made at the 
beginning of the thesis must be investigated further; the massless, inextensible 
towline, and the no wind, wave, or current (disturbances) assumptions. In reality 
the towline tension does not remain constant; consequently, the surge velocity u 
of the towed vessel will also vary. A method to take these aspects of motion into 
account needs to be looked at; integral control is one possibility. Another is to 
determine a wave and towline function, and add the two functions to the night 
side of the sway and yaw equations of motion. 

This thesis has shown that it is possible to stabilize and control the motion 
of a towed vessel with a sliding mode control law that uses linear quadratic 
regulator gains. Further analysis needs to be done on the effects of disturbances 


and a time-variant towline tension on the system. 
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APPENDIX 


TABLE I. TOWED VESSEL DATA 


Vessel 
Property Barge Tanker 
LBP, ft 19iese 1066.3 
x! -0.00136 -0.0009 
m! 0.170 0.0181 
y! -0.01383 -0.0171 
ve -0.0153 -0.0261 
i 0 0 
a 0.00238 0.00365 
Ni 0 0 
Ni -0.007285 -0.0105 
Il-N, 0.00188 0.00222 
Ny -0.00128 -0.0048 


Mariner 


928 
-0.0004444 


0.00888 
-0.00912 


-0.01434 


0.00456 


-0.0046 


0.00115 
-0.00296 


TABLE 2. NONDIMENSIONAL TERMS 


m’ =m/m, ae ene) 1) 
ae / u. Yo =Y,/m, 
vi=ev/u, Yp=%y=¥,/ (mu) 
ey tu, - L ) eg = Ye) mn, Gs 
ee / (es - L) N, =N,/ (m,u,) 

me -eey (u,-L) (time) N,=N,/ (m,L) 
fe fae mL? ) N; = Ny =N,/ (m,u,L) 
ri sw =wW/ (u,/L) N, =Ny=N,/ (m,L?) 
aay =W/ (us / L?) [=o aenea, / Ly) (-rension ) 
ex, / 1 ea is 

Ygty,/L xp =x, / L 

pee, / (mu,/ L’) Yp=Y,/L 
a= X, / m_ 
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MATRIX, LQR PROGRAM 


Xudot=-0.0009; 

M=0.0181; 

Yvdot=-0.0171; 

Y¥ v=-0.0261; 

Yrdot=0.0; 

Yr=0.00365; 

Ydel=0.0278; 

Nvdot=0.0; 

Nv=-0.0105; 

NrdotIz=-.00222 

Nr=-0.0048 

Ndel=-0.0139 

inquire LL 

inquire Xp 

inquire T 

Veg: 

L=1.0; 

D=Nrdotlz*(Yvdot-M)-Nvdot*Yrdot; 

a13=1.0; 

a24=1.0; 

a31=(1/D)*(T/LL)*(NrdotIz-Xp*Yrdot); 
a32=(1/D)*((Yv*U+T*(14+Xp/LL))*Nrdotlz-Yrdot*(Nv*U+T*Xp*(1+Xp/LL))); 
a33=(1/D)*(Nv*Yrdot-Y v*Nrdotlz); 
a34=(1/D)*((Yvdot*U-Yr)*Nrdotlz-Yrdot*(Nvdot*U-Nr)); 
a41=(1/D)*(T/LL)*(Xp*(Y vdot-M)-Nvdot); 
a42=(1/D)*((Yvdot-M)*(Nv*U+T*Xp*(1+Xp/LL))-Nvdot*(Yv*U+T*(1+Xp/LL))); 
a43=(1/D)*(Nvdot*Yv-Nv*(Yvdot-M)); 
a44=(1/D)*(Nvdot*Yr-Nr*Yvdot+(Nr-Nvdot*U)*M); 
b3=(1/D)*T*(Nrdotlz/LL-Yrdot*(1+Xp/LL)); 
b4=(1/D)*T*((Yvdot-M)*(1+Xp/LL)-Nvdot/LL); 
A=[0,0,a13,0;0,0,0,a24;a31 ,a32,a33,a34;a41,a42,a43,a44]; 
B=[0;0;b3;64]; 

C=|0. 0.10) 

D=(0}; 

OQ=[0 0 0 0;0 131.3316 0 0;0 0 0 0;0 0 0 0]; 

inquire alpha 

R=[(1 /alpha)**2]; 

<EIG,K>=REGULATOR(A,B,Q,R); 

INQUIRE TP 
A1=[-1/TP,0,0,0,0;0,0,0,1,0;0,0,0,0,1;B3,A31,A32,A33,A34;B4,A41,A42,A43,A44]; 
B1=[1/TP;0;0;,0;0]; 

S=[1,K]; 

G1=-INV(S*B1)*S*A1; 

G2=-INV(S*B]1); 

ETA2=G2 

GAIN=G1 

SIGMA=S 
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LINEAR SIMULATION PROGRAM 


REAL KY?P,K1,K2,K3,K4,L,LL,Nvdot,M,Nv,Nr,Nrdot 
Xudot=-0.0009 
M=0.0181 
Y¥vdot=-0.0171 
Yv=-0.0261 
Yrdot=0.0 
Yr=0.00365 
Ydel=0.0278 
Nvdot=0.0 
Nv=-0.0105 
Nrdot=-0.00222 
Nr=-0.0048 
Ndel=-0.0139 
U=1.0 

E=1.0 


OPEN (10,FILE=’LINEAR.DAT’,STATUS=’OLD’) 
OPEN (11,FILE=’Y.DAT’,STATUS=’NEW’) 
OPEN (12,FILE=’PSI.DAT’ STATUS=’NEW’) 
OPEN (13,FILE=’YP.DAT’,STATUS=’NEW’) 
OPEN (14,FILE=’YPC.DAT’,STATUS=’NEW’) 


READ (10,*) TSIM,DELTAT,IPRNT 
READ (10,*) KYP,K1,K2,K3,K4 
READ (10,") SYP,51,52,53,54 
READ (10,*) GBAR 

READ (10,*) TP,LL,XP,T 

READ (10,*) ETA2,PHI 

READ (10,*) Y,PSILSAT 


ISIM=TSIM/DELTAT 
PI=4.0*ATAN(1.0) 
PHI=PHI*P1/180.0 
PSI=PSI*PI/180.0 
SATP= SAT 
SATM=-SAT 
X1=Y 

X2=PSI 

X3=0.0 

X4=0.0 

YP=0.0 

YPC=0.0 


D=Nrdot*(Yvdot-M)-Nvdot*Yrdot 
al3=1.0 
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@a OO 


Ora 


oe 


a24=1.0 

a31=(1/D)*(T/LL)*(Nrdot-Xp*Yrdot) 
a32=(1/D)*((Yv*U+T*(1+Xp/LL))*Nrdot-Yrdot*(Nv*U+T*Xp*(1+Xp/LL))) 
a33=(1/D)*(Nv*Yrdot-Yv*Nrdot) 
a34=(1/D)*((Yvdot*U-Yr)*Nrdot-Yrdot*(Nvdot*U-Nr)) 

a41=(1/D)*(T /LL)*(Xp*(Y vdot-M)-Nvdot) 
a42=(1/D)*((Yvdot-M)*(Nv*U+T*Xp*(1+Xp/LL)) 

& -Nvdot*(Yv*U+T*(1+Xp/LL))) 
a43=(1/D)*(Nvdot*Yv-Nv*(Yvdot-M)) 
a44=(1/D)*(NvdotYr-Nr*Yvdot+(Nr-Nvdot*U)*M) 
b3=(1/D)*T*(Nrdot/LL-Yrdot*(1+Xp/LL)) 
b4=(1/D)*T*((Yvdot-M)*(1+Xp/LL)-Nvdot/LL) 


SIMULATION BEGINS 


Ber Visim 
YPDOT =-YP/TP+YPC/TP 
X1DOT = X3 
X2DOT = X4 
X3DOT = B3*YP + A31*X1 + A32*X2 + A33*X3 + A34*X4 
X4DOT = B4*YP + A41*X1 + A42*X2 + A43*X3 + A44*X4 


YP = YP + YPDOT*DELTAT 
X1 = X1 + XIDOT*DELTAT 
X2 = X2 + X2DOT*DELTAT 
X3 = X3 + X3DOT*DELTAT 
X4 = X4 + X4ADOT*DELTAT 


CONTROL LAW 


SIGMA = SYP*YP + S1*X1 + S2*X2 + S3*X3 +S4*X4 
SATSGN= SIGMA/TAN(PHD 

IF (SATSGN.GE.(+1.0)) SATSGN=+1.0 

IF (SATSGN.LE.(-1.0)) SATSGN=-1.0 

UHAT = KYP*YP + K1*X1 + K2*X2 + K3*X3 + K4*X4 
UBAR = ETA2*GBAR*SATSGN 

YPC = UHAT+UBAR 

IF (YPC.GE.SATP) YPC=SATP 

IF (YPC.LE.SSATM) YPC=SATM 


Y =X1 
PSI=X2 


PRINT RESULTS 


J=J+1 

IF J.NE.IPRNT) GO TO 1 
TIME=I*DELTAT 

WRITE (*,*) TIME,Y 
WRITE (11,*) TIME,Y 
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WRITE (12,*) TIME,PSI*180.0/PI 
Paieed>,) TIME, YP 
WRITE 4,*) TIME,YPC 
JEG 
1 CONTINUE 
SrOP 
END 


pl 


)} £ECre 


NON-LINEAR SIMULATION PROGRAM 


NONLINEAR SIMULATION - TANKER 
SURGE NOT INCLUDED 


REAL KY?P,K1,K2,K3,K4,L,LL,NVDOT,NV,IZ,NRDOT,NR,NVRR 


XUDOT=-0.0009 
M =0.0181 
YVDOT=-0.0171 
YV =-0.0261 
YRDOT= 0.0 
YR = 0.00365 
NVDOT= 0.0 
NV =-0.0105 
IZ =0.0 
NRDOT=-0.0022 
NR =-0.0048 


O- Sie 
SB = SB/(0.5*RHO*L*L*UTOW*UTOW) 


OPEN (10,FILE=’LINEAR.DAT’,STATUS=’OLD’) 
OPEN (11,FILE=’Y.RES’,STATUS=’NEW’) 

OPEN (12,FILE=PSLRES STATUS=NEW ) 

OPEN (13,FILE="YP.RES STATUS=NEW ’) 

OPEN (14,FILE="YPC.RES’ STATUS="NEW’) 

OPEN (15,FILE=’NONLINEARI.RES’,STATUS=’NEW’) 


READ (10,7) TSIM,DELTAT, IPRNT 
READ (10,*) KYP,K1,K2,K3,K4 
READNIO? VSieb S152 53,54 
READ (10,7) GBAR 

READ (1G) TEE XT 

READ (10,*) ETA2,PHI 

READ (10,*) Y,PSLSAT 


ISIM = TSIM/DELTAT 
PI = 4.0*ATAN(1.0) 
PHis= Tuer, 1800 
PSI = PSI*PI/180.0 
SATP = SAT 

SATM =-SAT 


2 


Cy Tee) atte) 


Ora) 


yO) 


X =LL-XP 
U =1.0 

V =0.0 

R =0.0 
YP =0.0 
YPC =0.0 


DEN=(M-YVDOT)*(IZ-NRDOT)-YRDOT*NV DOT 
SIMULATION BEGINS 
DO 1 I=1,ISIM 


F2=YV*V+0.5*YV RR*V*R*R+(YR-M)*R 
F3=NV*V+0.5*NVRR*V*R*R+NR*R 


SING=(Y+XP*SIN(PSI+YP*COS(PSD) /LL 
GAMMA=ASIN(SING) 


PEDO) =-YP/tP+YPC/TP 

VDOT =(F2-T*SIN(GAMMA+PSI))/(M-YVDOT) 

RDOT =(F3-T*XP*SIN(GAMMA+PSI)-T*YP*COS(GAMMA+PS])) /(IZ-NRDOT) 
YDOT =U*SIN(PSI)+V*COS(PSI) 

PSIDOT=R 


ieee) Pe YP D@] *DELTAT 
U =U + UDOT *DELTAT 
V =V +VDOT *DELTAT 
R =R +RDOT *DELTAT 
X =X +XDOT *DELTAT 
Y =Y + YDOT *DELTAT 
PSI = PSI + PSIDOT*DELTAT 


CONTROL LAW 


SIGMA = SYP*YP + S1*Y + S2*PSI + S3*YDOT + S4*PSIDOT 
SATSGN= SIGMA/TAN(PHI) 

IF (SATSGN.GE.(+1.0)) SATSGN=+1.0 

IF (SATSGN.LE.(-1.0)) SATSGN=-1.0 

UHAT = KYP*YP + K1*Y + K2*PSI + K3*YDOT + K4*PSIDOT 
UBAR = ETA2*GBAR*SATSGN 

YPC = UHAT+UBAR 

IF (YPC.GE.SATP) YPC=SATP 

IF (YPC.LE.SSATM) YPC=SATM 


PRINT RESULTS 
J=J+1 


IF (J.NE.IPRNT) GO TO 1 
TIME=I*DELTAT 


os) 


WRITE (;)) TIMED 

WRITE (1157) Mine 

WRITE (12,*) TIME,PSI*180.0/PI 

WRITE (13,*) TIME, YP 

WRITE (14,*) TIME, YPC 

WRITE (15,*) TIME, Y Pol 130}07 ie 
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